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ABSTRACT 


An  under-actuated  robot  manipulator  is  one  that  has  fewer 
number  of  joint  actuators  than  the  number  of  degrees  of 
freedom  of  the  manipulator.  Such  manipulators  are  studied 
with  the  objective  of  developing  "smarter"  mechanical  systems; 
ones  that  can  provide  low-cost  automation,  and  enable  design 
simplification.  While  in  space  these  manipulators  can  afford 
to  have  any  kind  of  mechanical  structure,  on  earth  they  need 
to  be  strictly  planar  to  be  feasible.  In  this  paper,  we 
develop  a  control  scheme  for  a  three  link  planar  robot 
manipulator  with  two  actuators  such  that  it  can  reach  any 
joint  configuration  from  any  other.  We  assume  that  the  first 
joint  of  the  robot  is  passive,  and  is  provided  with  a  brake 
and  a  rotary  dashpot.  We  show  that  our  control  is  robust  to 
the  variations  in  certain  parameters  and  unmodelled  dynamics 
like  stiction. 
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I  INTRODUCTION 


Robot  manipulators  with  passive  joints  have  been  studied 
by  a  few  researchers  for  terrestrial  and  space  applications 
[1],  [2],  [3],  [4].  In  space,  such  manipulators  can  have  any 
kinematic  configuration  because  of  the  absence  of  gravity  but 
on  earth  the  concept  of  under-actuation  can  only  be  promoted 
among  planar  kinematic  configurations.  The  purpose  of  this 
research  is  to  look  into  the  possibility  of  successfully  using 
under-actuated  manipulators  on  earth.  Arai  and  Tachi  [1] 
surmised  that  it  would  be  difficult  to  control  both  the 
passive  and  active  joints  simultaneously  to  reach  the  desired 
position  precisely  while  the  passive  joints  are  free.  They 
maintained  that  control  is  easier  using  a  brakes-on  period 
while  the  actuated  links  are  providing  momentum  to  the 
unactuated  link  followed  by  a  brakes-off  period  which  will 
allow  the  unactuated  joint  to  converge  to  its  final  position. 
The  mechanism  would  then  apply  brakes  and  allow  the  actuated 
joints  to  converge  to  its  final  position.  Simulations  were 
demonstrated  using  a  two  degree  of  freedom  manipulator.  We 
will  consider  the  point  to  point  control  of  a  three-link 
planar  manipulator  with  two  actuators  and  a  passive  first 
joint.  We  will  provide  a  surge  velocity  in  order  to  allow  the 
unactuated  joint  to  converge  to  its  desired  position. 
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Robot  manipulators  with  passive  joints  are  unconventional 
but  there  is  a  great  potential  for  using  such  systems.  On 
earth,  under-actuated  manipulators  will  enable  design 
simplification  and  provide  low-cost  automation.  The  most 
significant  part  of  the  design  of  a  robot  manipulator  lies  in 
the  selection  of  its  actuators,  the  design  task  will  be 
simplified  to  a  great  extent.  Also,  the  actuators  along  with 
the  drive  accounts  for  a  significant  part  of  the  cost  of  a 
robotic  system.  With  fewer  actuators,  an  under-actuated 
manipulator  will  be  cheaper  than  a  conventional  manipulator. 
However,  the  power  consumption  of  an  under-actuated 
manipulator  may  not  be  less  than  that  of  a  completely  actuated 
system.  The  concept  of  under-actuation  can  also  be  applied  to 
a  completely  actuated  system  with  actuator  failures.  This  is 
particularly  useful  for  space  applications  where  repair  or 
replacement  may  not  be  an  easy  task. 

Jain  and  Rodriguez  [2]  developed  the  kinematics  and  the 
dynamics  of  under-actuated  manipulators.  They  used  the 
techniques  from  the  spatial  operator  algebra  to  develop 
expression  for  the  generalized  Jacobian,  the  mass  matrix  and 
an  efficient  inverse  dynamics  algorithm.  The  spatial  operator 
is  a  robot  modeling  and  analysis  framework  which  is  used  to 
provide  a  compact  description  of  the  robot  model  and  to  derive 
efficient  recursive  algorithms  for  robotics  computations. 
This  algorithm  is  a  hybrid  combinations  of  well  known  inverse 


2 


and  forward  dynamics  algorithms  for  fully-actuated 
manipulators. 

In  this  paper,  we  consider  the  control  problem  of  a  three- 
link  planar  under-actuated  manipulator  using  the  Lagrangian 
approach  to  develop  the  equations  of  motion.  We  assume  the 
passive  joint  to  be  equipped  with  a  brake  that  will  be  used 
for  tasks  like  force  control,  and  for  the  switching  of  control 
inputs.  Additionally,  the  passive  joint  will  have  a  rotary 
dashpot  for  greater  control,  and  a  position  sensor  feedback. 
Clearly,  we  are  considering  a  completely  different  class  of 
mechanical  systems  where  some  of  the  actuators  are  replaced  by 
viscous  dampers.  These  systems  will  be  cheaper  and  will  be 
easier  to  design  but  will  not  necessarily  provide  solutions  to 
systems  with  actuator  failures.  The  simulations  of  the  three- 
link  planar  under-actuated  manipulator  will  be  studied  in  the 
following  manner: 

1.  The  damping  at  the  unactuated  joint  is  constant  and 
there  are  no  parmetric  uncertainties  or  unmodelled 
dynamics . 

2.  The  damping  at  the  unactuated  joint  is  not  constant  and 
varies  randomly  with  time. 

3.  The  damping  at  the  unactuated  joint  varies  randomly  in 
time  and  there  is  also  stiction  at  the  first  joint. 
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II  DYNAMICS  OF  A  PLANAR  THREE-LINK  UNDER-ACTUATED 
MANIPULATOR 

The  equations  of  motion  for  the  manipulator  will  be 
derived  considering  the  way  in  which  torque  cause  motion.  He 
adopt  the  Lagrangian  approach  to  solve  this  problem.  The 
Lagrangian  dynamics  approach  is  an  energy  based  approach  to 
dynamics.  In  this  section  we  develop  the  equation  of  motion 
of  the  three  link  under  actuated  manipulator.  The  Lagrangian 
is  defined  as 

L=T-V  (2.1) 

where,  T  and  V  are  the  kinetic  energy  and  potential  energy  of 
the  system.  The  kinetic  energy  is  a  function  of  both  the 
joint  position  and  velocities.  The  potential  energy  for  the 
system  is  equal  to  zero  due  to  the  absence  of  gravity  in 
space.  While  considering  Figure  1,  we  compute  the  position 
vectors  as 

ri“  2  cos02J+  2  sineiJ 

r2=  [IjCosO^  —  cos  Oi+Qj)  ]  i+  [i1sin01  +  —  sin  ]  j 

£  £ 
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r3=  [ llcos&1+l2cos  (01-*-02)  +  ^r-cos  (O^Oj+Oj)  ]  i 
+  [  J1sin01+i2sin  (0x+02)  +-^sin  ]  j 


C 


Figure  1:  A  three  link  planar  under-actuated 
manipulator  is  shown  whose  first  joint  is 
passive.  The  passive  joint  has  a  brake 
and  a  rotary  dashpot. 


From  Eq.  (2.2)  we  compute  the  linear  velocities  of  each  link  as 


A=_JjLsinMii+-^coseAj 

f2=  [-i1sin0161--^sin(01+02)  (01+02)  ]  i 

+  [i1cos0101  +  -^cos  (Oi+Oj)  <01+02)  ]  j 

^3=- [l1sin0101+l2sin  (0x+02)  (©i+02)  ♦■^sin  (©3+02+03)  (03+02+63)  1 

+  [130080303+12008(03+02)  (0!+02)  +^COS  (02+02+03)  (02+02 +03 ) ] J 

(2.3) 

from  which  we  can  compute  the  total  kinetic  energy.  The  total 
kinetic  energy  is  equal  to 

K.E.  =^m1±l+±m2t2+±m3±Z+±I1bl+I2(b1+b2)2  +  ±I3(b1+b2+to3)2 


(2.4) 

where  I  is  defined  as  the  inertia.  The  expanded  version  of 
the  kinetic  energy  is 


1  2  1  2 

K.  E.  =-§^2  <-jA>  +  +  A+02)  2+1i120i  (03+02)  COS02) 


(03+02+03)  2+2l3l20i  (03+02)  COS02 
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+i1J361  (0x+02+03)  cos  (02+03)  +I2i3  (di+d^  (0x+0j+03)  cos03 


*\ T&*1 T*  (e»+6>)  2*\  J3  <d1^2+e3>  2 


The  Kinetic  energy  in  matrix  form  is 


x.F.-A(6le29J)| 


•^11^12^13 
A21A22A23 
V^31-^32-^33/ 


\(t 


0 


where , 


i 2  i  1 2 

Axl=  +w2lx  +m2—~  +/n2i1i2cos02+/n3i22+/n3-^-  +2m3l1l 


+/n3i1J3 cos  (02+03)  +W3i2i3cos03+J1+J2+J3 


J 2  l  J 2 

A12=W2-7-  +-^/n2JlJ2COS®2+in3-Z22+%~7'  +^lx^2COS^2 


+  -|j7?3i1i3COS  (02+03)  +/7?3I2i3COS03+J2  +  J3 


J  ^ 

A13=m3"J-  +-|in3JlJ3COS  <02+03>  +-^3i2i3COS03+J3 


(2.5) 


(2.6) 


2COS02 


n 


i  * 

A22^m2  —  +Af3i|+/n3-j-  +m3l2l3cos03  + J2+I3 


^33  =m3  "J"  +'2m3^a^3^0®®3  +-^3 


i32 

A33=m3—  +  J3 


•^31=^13 


a32=a23 


(2.7) 

From  Eq. (2.6),  the  Lagrangian  is  computed  as 

l=o  .  5  (A11e2+2A12e1e2+2A1301e3M2262+2A23e2e3+A33e2) 

(2.8) 

The  equation  of  motion  for  our  three  degree  of  freedom 
manipulator  can  be  written  as 

OL/aep  -dL/de^ xit  (1=1-3) 

(2.9) 

where  we  assume  the  first  joint  of  our  manipulator  of  be 
passive.  The  second  term  of  Eq.(2.9),  dL/d@1,  equals  zero 
because  L  is  not  a  function  of  6}  .  The  third  term  of 
Eq.(2.9),  rl7  is  also  equal  to  zero  since  no  torque  is  applied 
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applied  at  the  first  joint  (in  the  case  where  there  are  no 
external  generalized  forces  corresponding  to  ©j) . 
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Ill  CONTROL  OR  AN  UNDER- ACTUATED  MANIPULATOR  IN  JOINT  SPACE 


A.  DYNAMIC8  OF  A  PLANAR  MANIPULATOR  WHOSE  FIRST  LINK  18  NOT 

ACTUATED 

In  this  section  we  consider  the  dynamics  of  a  three-link 
planar  under-actuated  robot  manipulator  with  revolute  joints. 
The  manipulator  is  assumed  to  be  planar  primarily  because  we 
would  like  to  investigate  the  possibility  of  using  such 
manipulators  on  earth.  In  the  past  under-actuated  space 
manipulators  have  been  considered  [3].  We  consider  the 
manipulator  to  have  three  links  because  a  minimum  of  three 
degrees  of  freedom  is  required  to  perform  tasks  with 
dexterity.  Our  current  research  is  aimed  at  studying  the 
feasibility  of  a  three-link  manipulator  where  the  first  joint 
of  the  manipulator  does  not  have  an  actuator.  The  passive 
joint  is  however  provided  with  a  brake  and  a  rotary  dashpot. 
The  brake  is  essential  if  the  manipulator  has  to  perform  tasks 
like  force  control  and  for  switching  of  control  inputs.  The 
dashpot  provides  us  with  improved  control  over  the  system. 
The  passive  joint  is  also  equipped  with  a  position  sensor. 

The  joints  of  the  robotic  system  are  designated  as  01#  e2, 
and  e3  where,  Q1  is  the  only  unactuated  joint.  The  choice  of 
the  location  of  the  unactuated  joint  is  motivated  by  two 
factors:  (a)  The  first  motor  of  the  robot  is  design  to  be  the 
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most  powerful  actuator  and  its  elimination  will  save  the 
maximum  cost,  (b)  The  first  joint  of  the  robot  is  a  cyclic 
coordinate,  that  allows  us  to  partially  integrate  the 
corresponding  differential  equation  when  there  are  no 
generalized  forces  acting  at  the  first  joint.  If  the 
Lagrangian  of  the  system  is  L,  the  equation  of  motion  for  the 
first  joint  can  be  written  as 

-A  oj)/  (ae,)  =o 

(3.1) 

When  there  are  no  external  generalized  forces  acting  at  the 
first  joint.  Equation  (3.1)  can  be  simplified  to  the  form 


(3.2) 

where  k  is  a  constant  that  depends  upon  the  initial 
conditions.  Ai;i,  A12,  and  A13  elements  of  the  mass  matrix  of 
the  system  were  found  from  Eq.(2.7). 

We  now  include  passive  damping  at  the  unactuated  joint  of 
the  robot  using  a  rotary  dashpot.  If  the  damping  constant  of 
the  rotary  dashpot  is  assumed  to  be  C,  then  Eq(3.2)  would  be 
modified  to  the  form 

(3.3) 

The  above  equation  acts  as  a  scleronomic  constraint  on  the 
motion  of  the  system.  From  this  equation  it  is  clear  that  if 
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the  constant  K  is  zero,  then  the  first  joint  behaves  as  a 
first  order  system  whenever  the  actuated  joints  02  and  03  have 
zero  velocity.  This  means  that  if  the  actuated  joints  stop, 
the  first  joint  exponentially  converges  to  the  configuration 
02=0  with  a  convergence  rate  of  C/A11.  We  note  here  that  An 
is  a  constant  whenever  the  actuated  joints  are  held  fixed.  If 
the  initial  conditions  of  the  system  are  such  that  K  is  equal 
to  celd  then  the  first  joint  will  exponentially  converge  to 
the  configuration  0ld  after  the  actuated  joints  have  stopped 
moving. 

B.  CONTROLLING  ALL  THE  JOINTS  OF  THE  MANIPULATOR 

In  this  section  we  develop  a  control  law  that  will  enable 
us  to  converge  all  the  joints  of  the  manipulator  from  an 
initial  configuration  to  its  desired  configuration.  In  this 
section  we  assume  that  there  are  no  parametric  uncertainties 
and  the  dynamics  of  the  system  given  by  Eq.(3.3)  is  an 
accurate  model. 

From  our  discussion  in  the  previous  section,  we  have  seen 
that  if  the  constant  K  is  chosen  appropriately,  the  first 
joint  can  be  made  to  exponentially  converge  to  any  desired 
configuration  by  simply  setting  the  actuated  joints  to  zero 
velocity.  Therefore,  if  all  the  joints  of  the  manipulator 
need  to  be  converged,  we  can  converge  the  actuated  joints 
first  and  then  hold  them  fixed  at  their  desired  configuration. 
The  unactuated  joint  will  then  converge  to  its  desired 
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configuration  9ld.  This  raises  two  questions:  (a)  How  can  we 
choose  X  to  converge  the  actuated  joint  to  its  desired 
configuration  ?  (b)  What  will  be  the  time  constant  of  the 
exponential  convergence  of  the  first  joint  once  the  actuated 
joints  stop  moving  ? 

We  answer  the  second  question  first.  The  term  An 
represents  the  total  inertia  of  the  planar  manipulator  about 
the  first  joint.  The  magnitude  of  the  damping  constant  C  will 
be  small  as  compared  to  the  magnitude  of  An  for  all  practical 
purposes.  Therefore,  the  time  constant  for  the  exponential 
convergence  of  the  first  joint,  given  by  A11/C,  will  be  quite 
large.  Due  to  the  large  value  of  the  time  constant,  the 
approach  discussed  above  for  the  convergence  of  all  the  joints 
of  the  manipulator  becomes  impractical. 

Before  we  modify  our  approach  for  the  convergence  of  all 
the  joints  of  the  manipulator,  we  answer  the  question 
pertaining  to  the  correct  choice  of  the  constant  K.  Let  us 
suppose  that  the  initial  configuration  of  the  unactuated  joint 
is  0^,  and  let  us  assume  that  all  the  joints  of  the 
manipulator  have  zero  velocity  at  the  initial  point  of  time. 
Then  from  Eq.(3.4)  the  value  of  the  constant  K  is  going  to  be 
C8 li.  For  setting  up  the  initial  conditions  such  that  the 
constant  K  is  equal  to  C9id,  we  can  adopt  the  following 
approach.  We  apply  the  brake  at  the  unactuated  joint  to  keep 
its  configuration  fixed  at  0li.  We  also  use  the  actuator  at 
the  third  joint  to  keep  the  configuration  of  the  third  joint 
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fixed.  We  can  actuate  the  second  joint  of  the  manipulator  to 
achieve  a  velocity  of  e2  such  that 


A1202=‘C(Bld-Bli) 

(3.4) 

This  velocity  will  not  be  a  constant  velocity  because  A12  is 
a  function  of  62  itself.  Once  Eq.(3.5)  is  satisfied,  we  will 
free  the  unactuated  joint.  This  will  now  set  the  value  of  the 
constant  in  Eq.(3.3)  as  K=CQldl  and  we  will  have  the  dynamical 
equation 

Aue1+Al2e2 +^363+0(6,-0^)  =0 


(3.5) 

The  initial  velocity  of  one  of  the  actuated  joints  that 
provide  us  with  the  necessary  initial  condition  will  be  termed 
as  the  "surge"  velocity. 

To  converge  all  the  joins  of  the  manipulator  to  their 
desired  configuration  with  a  satisfactory  rate  of  convergence, 
we  define  the  Lyapunov  function  in  the  following  way 

V\=O.5(p1Ae^+P2A0^P3Ae^  ,ABik(Bid-Bi)  ,i»l,  2, 3 

(3.6) 

where,  P2,  p2,  P3  are  positive  constants,  and  eid  and  are 
the  desired  and  the  current  configurations  of  the  i-th  joint 
of  the  manipulator.  The  derivative  of  the  Lyapunov  function 
can  be  computed  using  Eq.(3.3)  as 

(3.7) 
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where  A31  is  not  equal  to  zero  because  the  mass  matrix  is 
positive  definite.  In  the  above  equation,  if  we  choose  the 
joint  velocities  of  the  actuated  joints  as  our  inputs,  then 
the  choice 

e2=<Me!-P1-riA6i)'6>=(M63-Pi-ri4e>) 

■"ll  All 


(3.8) 

can  be  shown  to  result  in  the  globally  asymptotically  stable 
control  that  will  drive  the  system  to  its  desired 
configuration.  The  joint  torques  r2  and  t3  that  produce  the 
desired  joint  velocities  02  and  03  given  in  Eq.(3.8)  can  be 
obtained  by  simply  performing  the  inverse  dynamics 
computation,  or  better  yet  by  redefining  the  Lyapunov  function 
in  the  following  way 


(3.9) 

where  H  is  the  Hamiltonian  of  the  system  and  is  equal  to  the 
total  kinetic  energy  of  the  under-actuated  manipulator  system. 
By  knowing  that 

cOi+  62T2+e3T3 
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the  derivative  of  V2  can  be  shown  to  be  negative  definite  when 
the  control  inputs  r2  and  t3  are  chosen  as 


'll 


(3.10) 

where  a2  and  a3  are  some  arbitrary  constants. 

It  is  important  to  make  one  comment  at  this  point. 
Equations  (3.8)  and  (3.10)  can  both  be  used  to  plan  the  motion 
of  the  system.  Equation  (3.8)  plans  the  motion  at  a  kinematic 
level  and  Eq.(3.10)  plans  the  motion  at  the  dynamic  level. 
While  Eq.(3.i0)  is  more  complete  in  a  sense,  it  neglects  the 
presence  of  friction  at  the  actuated  joints.  On  the  other 
hand,  Eq.(3.8)  can  be  used  to  provide  the  actuators  with  a 
reference  trajectory.  The  actuators  can  then  accurately  track 
these  trajectories  using  a  PID  control  scheme.  Then  friction 
can  be  simply  considered  as  external  disturbances  to  the 
system. 


C.  PARAMETRIC  UNCERTAINTIES  AND  UNMODELLED  DYNAMICS 

In  this  section  we  take  into  consideration  the  fact  that 
the  unactuated  joint  will  have  stiction  and  the  damping 
parameter  C  of  the  rotary  dashpot  will  not  be  a  constant.  The 
unactuated  joint  will  use  roller  bearings  and  therefore  we 
assume  that  the  magnitude  of  stiction,  which  is  unknown,  is 
quite  low.  Furthermore,  we  assume  that  the  nominal  value  of 
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the  damping  parameter  is  C  and  the  true  damping  in  the  system 
is  of  the  form 


C(t)  =C+€  (  t) 

(3.11) 

where  we  have  assumed  the  damping  in  the  system  to  be  an 
implicit  function  of  time.  In  reality  the  damping  parameter 
will  be  an  explicit  function  of  the  unactuated  joint  position, 
the  temperature  of  the  silicone  fluid  in  the  dashpot,  etc. 

We  begin  by  stating  that  the  generalized  momentum 
corresponding  to  the  first  joint  of  the  system  is  defined  as 


PjAOL/adj)  =Au61fA12e2+A13e3 

(3.12) 

and  is  a  constant  of  the  motion  in  the  absence  of  external 
generalized  forces.  In  our  case  there  is  stiction  and  viscous 
damping  in  the  system  that  requires  us  to  modify  Eq.(3.1)  of 
the  form 


-^  =  -C(t)$1-fssgn(01) 

(3.13) 

where  f8  is  the  magnitude  of  the  stiction  that  opposes 
torque  and  need  not  be  assumed  constant.  From  the  above 
equation,  we  can  write 


dp1  =  -C(  t)  d61-fssgn(61)  dt 


(3.14) 
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where  the  left  hand  side  of  Eq.(3.14)  represents  a  change  in 
the  generalized  momentum  plt  and  the  right  hand  side 
represents  the  impulse  of  the  non-conservative  friction 
forces.  We  note  here  that  dpx  can  be  easily  computed  from  the 
measured  values  of  pj  in  successive  sampling  intervals.  The 
expression  for  pj  is  given  in  Eq.  (3.12)  and  can  be  computed  at 
any  instant  from  the  measured  values  of  the  joint  angles  of 
the  actuated  joints  and  all  the  joint  velocities. 

We  return  to  Eq.(3.l3)  and  rewrite  the  system  dynamics  as 

~  +A  =  -€  ( t)61-fesgn(B1) 


which  can  be  simplified  to 


(3.15) 


(A1161+A1262+A1363+501)  t-  to-/  PdB^+dp^ 


(3.16) 


by  adopting  the  same  method  as  in  the  last  section,  we  provide 
the  second  joint  with  a  •’surge'*  velocity  at  the  initial  point 
of  time  such  that  Eq.(3.4)  is  satisfied  while  the  first  and 
the  third  joint  are  held  fixed.  Then  we  obtain  from  Eq. (3.16) 

i4i16i+A1262+i41303-^A01=  T  tCd61+dp1 

Jo 

(3.17) 

We  redefine  the  Lyapunov  function  V2  in  Eq.(3.9)  as  V3, 
where  we  now  treat  02d  as  a  variable.  We  allow  02d  to  vary  in 
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order  to  cancel  the  effect  of  any  uncertainties  and  unmodelled 
dynamics  that  are  present  in  the  system.  The  derivative  of 
the  Lyapunov  function  is  computed  as 


"ll  "ll 


IMe2M-  (MV^h)  (Udde^dp,)  ] 

A-t  -i  *  0 


(3.18) 


Our  choice  of  the  control  torques  r2  and  t3  as  in  Eq.(3.10) 
along  with  the  choice  of  02d  as 


V(PiA0i/PaA0Ai)  fUcdQ^dp,) 

(3.19) 

results  in  the  derivative  of  V3  in  Eq.(3.18)  as  negative 
definite  and  leads  to  the  convergence  of  the  unactuated  joint 
and  third  joint  to  their  desired  values.  Additionally,  the 
second  joint  is  converged  to  its  desired  configuration  which 
is  different  from  the  initially  specified  value.  The  desired 
configuration  of  the  second  joint  was  not  a  constant  but  was 
made  to  follow  a  trajectory  to  compensate  for  the  unmodelled 
friction  forces.  If  the  magnitude  of  the  unmodelled  stiction 
force  and  the  uncertainty  in  the  damping  factor  are  small,  the 
second  joint  will  be  converged  to  a  value  02d  at  (t=tf)  which 
will  be  quite  close  to  the  initial  desired  value  of  02,  i.e. 
02d  at  (t=0) .Therefore  after  the  convergence  of  the  Lyapunov 
function,  the  brake  can  be  applied  at  the  first  joint  and  the 
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third  joint  can  be  held  fixed  at  its  desired  configuration 
while  the  second  joint  is  takes  from  its  configuration  e2d  at 
(t=tf )  to  e2d  at  (t=0) . 
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IV  RE8ULT8  AMD  DISCUSSION 


A.  CONTROLLING  OF  JOINTS  IN  THE  AB8ENCE  OF  UNCERTAINTIES 

We  assume  the  three-link  planar  under-actuated 
manipulator,  as  shown  in  Fig.l,  to  have  the  following 
kinematic  and  dynamic  parameters  in  S.I.  units 


Kinematic  and  Dynamic  parameters 


Mass 

Inertia 

Length 

link-1 

2.06 

0.042917 

11=0.5 

link-2 

2.06 

0.042917 

12=0.5 

link- 3 

2.06 

0.042917 

13=0.5 

All  three  links  of  the  manipulator  were  assume  to  have  a 
uniform  mass  distribution.  In  the  first  simulation,  the 
initial  and  desired  configuration  of  the  system  were  assumed 
to  be 

(6^62,63)  ■(0.0,45.0,0.0) 

(63,62,63)  h(20.0,0.0,45.0) 

(4.1) 

and  in  the  second  simulation,  the  initial  and  the  desired 
configurations  were  assumed  to  be 
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(e^e^ej)  «(io.o,45.o,5.o) 

(01,02,e3)  *(22.5, 15.0,  -25.0) 

(4.2) 


where  the  units  were  in  degrees. 

In  both  cases  the  damping  constant  was  assumed  to  be  0.2 
8.1.  units  and  the  criterion  for  the  convergence  of  the 
lyapunov  function  was  set  at  5.0xl0“5.  The  evolution  of  the 
joint  variables  for  the  two  simulations  are  shown  in  Figs.  (2) 
and  Fig.  (3)  respectively.  In  the  first  simulation  convergence 
is  achieved  in  only  11.5  seconds  whereas  the  time  taken  for 
the  second  simulation  is  12.0  seconds.  In  both  cases,  we  see 
that  the  transition  from  initial  position  to  final  position  is 
a  smooth  evolution.  This  is  due  to  the  absence  of 
uncertainties  in  the  system.  We  also  notice  that  link  2 
provides  a  surge  velocity  prior  to  the  release  of  links  1  and 
3.  This  surge  velocity  provides  link  1  with  the  initial 
momentum  needed  to  proceed  in  the  proper  direction  for 
convergence.  The  surge  velocity  coupled  with  the  motion  of 
link  two  provides  the  control  needed  to  bring  link  1  to  its 
final  destination. 
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B.  CONTROLLING  OF  JOINTS  WITH  UNCERTAINTIES 

The  simulations  are  for  the  case  in  which  parametric 
uncertainties  and  unmodelled  dynamics  exist.  In  this  section, 
we  shorten  links  2  and  3  in  order  to  further  test  the  system. 
Smaller  links  will  now  be  expected  to  control  a  larger  link  in 
addition  to  overcoming  uncertainties  that  may  be  in  the 
system.  We  assume  the  three  link  planar  under-actuated 
manipulator  to  have  the  following  kinematic  and  dynamic 
parameter  in  S.I.  units. 


j  Kinematic  and  Dynamic  parameters 

1 

Mass 

Inertia 

length 

1  link-1 

2.06 

0.043878 

11=0.5 

link-2 

1.86 

0.031881 

12=0.45 

link-3 

1.65 

0.022495 

13=0.4 

1.  Variation  of  damping  without  stiction 

As  a  next  step,  we  simulate  the  case  given  by  Eg.  (4.1) 
but  included  timewise  variation  of  damping  at  the  unactuated 
joint.  The  variation  of  damping  of  the  form 

e ( t) =. 02 sint+ . 015cost- . 02 5 sin4t 

(4.3) 

was  imposed  on  the  system.  This  is  a  slowly  varying  wave 
which  varies  within  25%  of  the  nominal  value,  0.2.  We  also 
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simulated  the  system  for  the  case  given  by  Eq.(4.1)  with  a 
damping  whose  variation  is  more  abrupt  at  the  unactuated 
joint.  This  variation  of  damping  is  of  the  form 


€  (  C)  =0  .  lC(sin5t+0 . 33 sinl5t) 

(4.4) 

The  two  terms  on  the  right  hand  side  of  Eq.(4.4)  are  the  first 
two  terms  of  the  fourier  expansion  of  a  square  wave  with  a 
time  period  of  0.2  seconds  and  an  amplitude  equal  to  10%  of 
the  magnitude  of  the  nominal  value  of  damping.  The  variation 
of  damping  of  Eq.(4.3)  and  Eq.(4.4)  is  shown  in  Fig. (4a)  and 
Fig. (4b) . 


0.25  - 
0.24- 
0.23- 
0.22- 
0.21  - 
0.2- 


f  0.19- 
^  0.18  - 


0.17- 

0.16- 

0  i' - - 

1  2  3  4  5  6  7  8  9  10 

time(seconds) 

Figure  4a:  Damping  of  the  form  described  by  Eq.(4.3) 
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Figure  4b:  Damping  of  the  form  described  by  Eq.(4.4) 

The  trajectory  of  the  joint  variables  and  e2d  under  the 
damping  influence  given  by  Eq.(4.3)  is  shown  in  Figs. (5a-5b) . 
The  time  required  for  the  simulation  was  only  8.3  seconds. 
All  joints  converged  to  its  desired  positions.  The 
transitions  of  the  links  to  their  final  positions  were 
relatively  smooth.  The  trajectories  of  the  joint  variables 
and  02d  under  the  damping  influence  described  by  Eq.(4.4)  are 
plotted  in  Figs. (6a-6b) .  The  time  required  for  the  simulation 
was  11.3  seconds.  The  trajectory  of  the  links  are  rather 
smooth.  A  shift  from  a  negative  slope  to  a  positive  slope  is 
experienced  by  02d.  This  shift  is  needed  in  order  to  bring 
link  1  to  its  final  position.  After  0^^  and  03  converge,  a 
brake  is  applied  and  02  is  allowed  to  exponentially  converge 
to  its  initial  desired  position. 
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Figure  5a:  Evolution  of  joints  for  case  one  under 
influence  of  damping  given  by  Eg. (4.3) 
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Figure  6a:  Evolution  of  joints  for  case  one  under 
influence  of  damping  given  by  Eg. (4.4) 
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Figure  6b:  Evolution  of  02^  for  case  one  under 
influence  of  damping  given  by  Eg. (4.4) 
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2.  Variation  of  damping  with  stiction 

a.  Variation  of  damping  given  by  Bq.(4.3) 

As  a  next  step,  we  simulate  the  same  two  cases  given 
by  Eq.(4.1)  and  Eq.(4.2)  with  the  timewise  variation  in  the 
coefficient  of  damping  given  by  Eq.(4.3).  We  also  include  a 
stiction  value  of  0.001  Newton-meters.  The  trajectory  of  the 
joint  variables  and  02d  is  given  in  Figs.(7a-7b)  for  the  case 
given  by  Eq.(4.1).  The  time  for  convergence  was  15.2  seconds. 
The  transition  from  the  initial  to  final  positions  were  smooth 
and  uneventful,  however,  abrupt  shifts  was  needed  by  02d 
towards  the  end  of  the  simulation  in  order  for  link  1  to 
converge.  The  trajectories  for  the  second  case  are  given  in 
Figs. (8a-8b) .  The  time  for  convergence  was  24.5  seconds.  It 
is  evident  that  the  trajectory  given  by  Eq.(4.2)  is  more 
difficult  to  achieve  than  the  one  given  by  Eq. (4.1) .  There  is 
more  interaction  between  link  2  and  link  1.  It  appears  that 
02d  went  to  15  degrees  but  after  time  it  became  evident  that 
in  order  for  link  1  to  converge  to  its  desired  position  02 
must  decline.  Sudden  shifts  of  link  2  was  needed  to  control 
link  1.  Link  2  went  below  10  degrees  before  it  finally  was 
allowed  to  exponentially  converge  at  its  desired  position. 
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Figure  7a:  Evolution  of  joints  tor  case  one  under 
influence  of  damping  given  by  Eg. (4.3) 
and  a  stiction  value  of  0.001. 
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Figure  7b:  Evolution  of  02d  for  case  one  under 

influence  of  damping  given  by  Eq.(4.3) 
a  stiction  value  of  0.001 
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Figure  8a:  Evolution  of  joints  for  case  two  under 

influence  of  damping  given  by  Eq.(4.3)  and 
a  stiction  value  of  o.ooi 
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Figure  8b:  Evolution  of  02d  for  case  two  under 

influence  of  damping  given  by  Eq.(4.3) 
and  a  stiction  value  of  0.001 
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b.  Variation  of  damping  given  by  Bq.(4.4) 


In  this  section  we  simulate  the  same  two  cases  given 
by  Eqs.(4.1)  and  (4.2).  The  ratio  of  length  of  actuated  links 
to  the  unactuated  link  was  increased  in  order  for  the  actuated 
links  to  have  an  increased  influence.  The  timewise  variation 
of  damping  given  by  Eq.(4.4)  and  an  increased  stiction  value 
of  0.005  is  applied  to  the  unactuated  joint.  For  the  first 
case  link  1  is  decreased  to  0.3  while  link  2  and  link  3  are 
increased  to  0.8.  The  trajectories  are  given  in  Figs. (9a-9b) . 
The  time  for  convergence  was  35.3  seconds.  Small  variations 
of  link  2  at  the  end  of  the  simulation  was  needed  to  bring 
link  1  to  its  desired  position.  A  satisfactory  simulation, 
however,  the  time  for  convergence  was  excessive.  For  the 
second  case  link  2  and  link  3  was  decreased  to  0.6.  The 
trajectories  are  given  in  Figs. (lOa-lOb) .  The  time  for 
convergence  was  42.8  seconds.  In  both  cases  we  find  that  the 
trajectory  is  not  as  abrupt  as  the  results  from  the  previous 
section,  even  though,  the  damping  is  more  abrupt  and  the 
stiction  is  increased  by  a  factor  of  five.  This  is  due  to  the 
increase  in  length  of  the  actuated  links  which  gives  them  more 
control  of  the  unactuated  link.  An  attempt  to  simulate 
Eqs(4.1)  and  (4.2)  under  the  damping  given  by  Eq.(4.4)  without 
changing  the  lengths  of  the  links  provided  unsatisfactory 
results. 


32 


tliciu(ilcg)  tlicia(deg) 


:oL  f 


iheta  j 


0  5  10  15  20  25  30 

time(seconds) 

Figure  9a:  Evolution  of  joints  for  case  one  under 

influence  of  damping  given  by  Eq.(4.4)  and 
a  stiction  value  of  0.005 
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Figure  9b:  Evolution  of  ©2d  for  case  one  under 

influence  of  damping  given  by  Eq.M.4) 
and  a  stiction  value  of  0.005 
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Figure  10a: 
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Evolution  of  joints  for  case  two  under- 
influence  of  damping  given  by  Eq.(4.4) 
a  stiction  value  of  0.005 
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Figure  10b:  Evolution  of  02d  for  case  two  under 

influence  of  damping  given  by  Eq.(4.4)  and 
a  stiction  value  of  0.005 
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V  CONCLUSIONS  AND  RECOMMENDATIONS 


Here  we  summarize  our  findings  and  we  recommend  future 

research  directions  as  follows: 

-From  the  simulation  results  it  is  quite  clear  that  even  in 
the  presence  of  unmodelled  dynamics  and  parametric 
uncertainties,  it  is  possible  to  converge  all  the  joints  of 
the  manipulator  from  their  initial  configuration  to  their 
desired  configuration. 

-It  is  apparent  that  the  value  of  stiction  can  impair  the 
ability  of  link  1  to  converge  to  its  desired  value. 

-It  is  obvious  that  increasing  the  ratio  of  length  of  the 
actuated  links  to  link  1  will  offset  the  stiction  that  is 
experienced  by  link  1. 

-It  is  recommended  that  research  be  done  with  the  increase  in 
the  mass  ratio  of  the  actuated  links  to  link  1. 

-It  is  recommended  that  a  prototype  of  a  three-link  planar 
under-actuated  manipulator  be  constructed  so  that  a  more 
accurate  model  can  be  simulated. 

-It  is  recommended  that  further  research  be  conducted  with 
joint  2  or  joint  3  unactuated  and  compared  the  model  examined 
in  this  paper. 

-In  some  of  the  simulations,  9-l  overshot  its  intended  target 
prior  to  settling  on  8ld.  It  is  recommended  that  a 
simulation  be  performed  that  will  stop  link  1  instead  of 
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allowing  it  to  pass  its  target.  A  comparison  of  this  model 
with  the  results  presented  in  this  paper  should  performed. 


36 


LIST  OF  REFERENCES 


[1]  Arai,  H. ,  and  Tachi,  S.,  1991,  MPosition  control  of  a 
manipulator  with  passive  joints  using  dynamic  coupling",  IEEE 
Transactions  on  Robotics  and  Automation,  Vol.  7,  No.  4,  pp. 
528-534. 

[2]  Jain,  A.,  and  Rodriguez,  G. ,  1991,  "Kinematics  and 
Dynamics  of  Under-Actuated  Manipulators",  Proc.  IEEE 
international  Conference  on  Robotics  and  Automation,  Vol.  2, 
pp  1754-1759. 

[3]  Mukherjee,  R. ,  and  Chen  D. ,  1993,  "Control  of  free-flying 
under-actuated  space  manipulators  to  equilibrium  manifolds". 
Transactions  of  the  IEEE  on  Robotics  and  Automation,  (to 
appear) . 

[4]  Oriolo,  G. ,  and  Nakamura,  Y.,  1991,  "Nonholonomic  motion 
of  under-actuated  kinematic  chains",  Proc.  9th  Annual 
Conference  of  Japan  Robotics  Society,  Tsukuba,  Japan. 


37 


INITIAL  DISTRIBUTION  LIST 


No .  Copies 

1.  Defense  Technical  Information  Center  2 

Cameron  Station 

Alexandria  VA  22304-6145 

2.  Library,  Code  052  2 

Naval  Postgraduate  School 

Monterey  CA  93943-5002 


3.  Professor  Ranjan  Mukherjee,  CodeME/Mk  2 

Department  of  Mechanical  Engineering 

Naval  Postgraduate  School 
Monterey  CA  93943-5000 

4.  LT  Pernell  A.  Jordan  2 

1529  West  First  Street 

Dayton  OH  45407 


38 


